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I Abstract In this paper we consider the problem of reconstructing a curve that is partially hidden 

' or corrupted by minimizing the functional J ^1 + /•ST^ ds, depending both on length and curvature 

. , K . We fix starting and ending points as well as initial and final directions. 

' For this functional we discuss the problem of existence of minimizers on various functional spaces. 

, We find non-existence of minimizers in cases in which initial and final directions are considered with 

orientation. In this case, minimizing sequences of trajectories can converge to curves with angles. 
We instead prove existence of minimizers for the "time-reparameterized" functional 

(N ' 



for all boundary conditions if initial and final directions are considered regardless to orientation. In 



• this case, minimizers can present cusps (at most two) but not angles. 

• Keywords: geometry of vision, elastica functional, existence of minimizers 
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1 Problems statements and main results 

Consider a smooth function 70 : [a, b] U [c, d] — )■ (with a < b < c < d) representing a curve that is partially 
hidden or deleted in (&, c). We want to find a curve 7 : [b,c] — >■ that completes 70 in the deleted part and 
that minimizes a cost depending both on length ^ (7) and curvature K^. 

The fact that 7 completes 70 means that 7(6) = 7o(&), 7(c) = 70(c). It is also reasonable to require that 
the directions of tangent vectors (with orientation) coincide, i.e. 7(6) ^ 70(^)7 7(c) ~ 7o(c) where 

vi ~ V2 if it exists a G such that vi = av2- (1) 

We call these conditions boundary conditions with orientation. All along this paper we assume that start- 
ing and ending points never coincide, i.e. jo{b) 7^ 7o(c), and that initial and final directions are nonvanishing. 

In the literature this problem has been deeply studied for its application to problems of segmentation of 
images (see e.g. [H [51 IHl HH] ) and for the construction of spiral splines [?]■ 

The cost studied in [SUTKH] is the total squared curvature Ei [7] = /q I-^'7(s)P ds where s is the arclength. 
In [31^ boundary conditions differ from our boundary conditions with orientations. In particular, starting and 
ending directions are fixed with angles measured in R (while we identify a and a 4- 2fc7r). In this framework, 
non existence of minimizers is proved if the starting and ending angles 9o,Oi satisfy |0i — 0o| > tt. 



The cost studied in is E2 [7] = (l + \K^{s)\'^) ds, while in [10] it is E3 [7] = J^^^' {v + \K^{s)\^) ds 

with r/ — > 0. Depending on the cost, minimizers may present angles and the curvature becomes a measure. 

The cost E4 [7] = J^^'^'^ -^/l + |iir-y(s)p ds naturally arises in problems of geometry of vision [SJ[T31[I1]. In 
this paper we study the following cost: 

J [7] = ^mw + \mwK^it)dt, (2) 

b 

that is an extension of E4 [7], see Remarks [2113] below. Using this cost one can study the existence of minimizers 
with angles without involving sophisticated functional spaces. Moreover, this problem has also been studied in 
[3], where it is defined on the sphere 5^ instead of the plane. 

Remark 1. The cost J is invariant both by rototranslation and reparametrization of the curve. 

Define the cost J/3 [7] := y/\\i{tW + P'^WHtWK^it) dt with a fixed P ^ Q. Consider an homothety 
(x, y) (/3a;, Py) and the corresponding transformation of a curve 7 = {x{t),y{t)) to — {f3x{t), (iy{t)). It is 
easy to prove that Jp [7^] ~f3'^J [7]. Hence the problem of minimization of Jp is equivalent to the minimization 
of J with a suitable change of boundary conditions. Thus, results about J given in this paper hold also for the 
cost J p. 

The first question we address in this paper is the choice of a set of smooth curves on which this cost is 
well-defined. We want 'y{t) and Kj{t) = ^y~y^^ well-defined, thus it is reasonable to look for minimizers in 

S^i := {7 e C2([6,c],M2) I 7(i) ^ Vt e [b,c], ^{b) = 70(6), 7(c) = 7o(c), i{b) ^ 70(6), 7(c) ^ 7o(c)} . 
Moreover, we have that 7(6) and 7(c) are well-defined in this case. 

Remark 2. The cost J [7] on the set i^i coincide with the cost E4 [7]. To prove it, reparametrizc a curve in 
by arclength and observe that in this case we have ||7|| = 1. 

Under this assumption, one of the main results of the paper is the nonexistence of minimizers for J. 

Proposition 1. There exist boundary conditions 7o(&),7o(c) G with 70(6) 7^ 7o(c), 70(^)7 7o(c) G ]R.^\ {0} 
such that the cost (0) does not admit a minimum over the set ^\ . 

To get existence of minimizers for this cost one can choose to enlarge the set of admissible curves. In this 
paper we consider the simplest generalization, by taking the space 

^.■■={i^c\{bA.^-) I ii7(t)f+ii7Wfi^,^(t)eL^([5,c],R), 

on which the cost J [7] is defined and always finite. 

Remark 3. Notice that the cost E4 [7] is not well defined on ^2, since it is not possible in general to perform 
an arclength parametrization. Then J [7] is an extension of E [7] , since they coincide on ^1 . 

Also on we have non-existence of minimizers for J. 

Proposition 2. There exist boundary conditions 70(6), 70(c) G with 70(6) 7^ 7o(c), 7o(^)j 7o(c) G M^\{0} 
such that the cost (0) does not admit a minimum over the set f^2- 

The basic problem is that we can have a sequence of minimizing curves converging to a non admissible 
curve. In particular, we can have angles at the beginning and/or at the end, i.e. each curve 7„ satisfies given 
boundary conditions with orientation but the limit curve 7 doesn't satisfy them. See Figure [TJ 

The main result of the paper is the existence of minimizers for the cost ^ taking again curves for which 
ll7(^)lP + ll7(^)lP-f'^7(^) is integrable, but changing boundary conditions. We only impose conditions on the 
direction of 7 regardless of its orientation. 
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Figure 1: Minimizing sequence converging to a non- admissible curve (angles at the beginning/end). 



As before, fix a starting point xq with a direction vq and an ending point xi with a direction vi. Consider 
planar curves satisfying the following boundary conditions: 7(0) = xq, 7(0) ~ vq, "f{T) = xi, 7(T) « vi, 
where the identification rule ~ is 

Vl ~ V2 if it exists a G M\ {0} such that vi = av2- (3) 

We call them projective boundary conditions. As already stated, we have the following existence result: 

Proposition 3. For all boundary conditions xo,xi G with xq 7^ xi, vo, vi G {0}, the cost ^ has a 
minimizer over the set 

^3 := {7e C2([&,c],R2) I \\j{t)f + \\j{t)fK'^{t)eL\[b,c\,R),^{b)=xo, 7(c) -xi, j{b)^vo, 7(c) 

Observe that we can have minimizers with cusps, as 7 in Figure [21 Indeed, the limit direction (regardless 
to orientation) is well defined in the cusp point, while the limit direction with orientation is undefined. 




Figure 2: A minimizer with a cusp. 



All the previous results are obtained as consequences of the study of two similar mechanical problems. For 
what concerns problems with boundary conditions with orientation, we consider a car on the plane that can 
move only forwards and rotate on itself (it is the Dubins' car, see [8]). Fix two points {xo,yo), (xi,yi) and 
two angles 6*0, Oi in these points measured with respect to the positive cc-semiaxis. Consider all trajectories q{.) 
steering the car from the point (xo,?/o) rotated of an angle Oq to the point {xi,yi) rotated of an angle 9i. Our 
goal is to find the cheapest trajectory with respect to a cost depending both on the length of displacement on 
the plane and on the angle of rotation on itself. 

The dynamics can be written as the following control system on the group of motions of the plane SE{2) := 
{ix,y,e) I {x,y)GR\ 9 GR/2n}: 



y = sin(0) + W2 (4) 




where x,y are coordinates on the plane and 9 represents the angle of rotation of the car. Since we forbid 
backwards displacements, we impose ui > 0. We want to minimize the cost 

[q{t)] = r ^ulit)+umdt (5) 
"'0 

with the following boundary conditions: a;(0) = xq, y(0) — yo, 0{O) ~ 9o, xiT) ~ xi, y{T) ~ yi, 9{T) ~ 9i. 
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Remark 4. Any smooth planar curve can be naturally transformed into an admissible trajectory of this control 
system. Indeed, given j{t) = {x{t),y{t)) , we set q{t) = {x{.),y{.),9{.)) where 9{t) is the angle of the tangent 
vector with respect to the positive x-semiaxis. This construction is called the lift of the curve 7. 

We then find suitable controls Ui corresponding to q{t) defined above. In this framework m plays the role of 
II7II, while U2 is ||7||i4r^. Hence, the cost (0 coincides with J [7] defined in ([2]). Moreover, boundary conditions 
with orientation can be easily translated to boundary conditions on {x,y,6) G SE(2). 

Notice that, on the contrary, not all trajectories of (|4]) are lifts of planar curves. Indeed, consider a trajectory 
of the system with ui = 0. It represents the rotation of the car on itself. If we consider its projection to the 
plane 11 : (a:, y, 9) (a;, y) the curve is reduced to a point, thus 7 = and the curvature is undefined. 

We will prove that for the optimal control problem (|4])-(l5]) on SE(2) we have existence of minimizcrs with 
controls. Starting from a minimizcr of this problem, we will find counterexamples to the existence of mini- 
mizcrs of J on ^1 and ^2 ■ 

For what concerns problems with projective boundary conditions, we study the dynamics given by @ where 
we admit also backwards displacements (it is the Reeds-Shepp car, see [16]). In this case we don't have to 
impose mi > and we identify {x,y,0) ~ {x,y,9 + Tr). Hence this dynamics is naturally defined on the quotient 
space SE(2)/ ~. We choose the same cost ([5]). Also in this case, it is possible to lift planar curves to curves 
on SE{2)/ ~. Projective boundary conditions can be easily translated to conditions on {x,y,9) G SE{2)/ ~. 

For the optimal control problem (U)-® on SE{2)/ ~ we have existence of minimizcrs with optimal 
controls. Its consequence on the problem of planar curves is the existence of minimizers of J in S!^. 

For both optimal control problems, the basic tool we use to compute minimizer is the Pontryagin Maximum 
Principle (PMP in the following), see |15j . It gives a necessary first-order condition for minimizers. Solutions 
of PMP are called extremals, hence minimizers have to be found among extremals. For details, see e.g. [1]. 

The structure of the paper is the following. In Section [2] we introduce the group SE{2) and the space 
SE{2)/ ~, and we define the optimal control problems on these spaces corresponding to the ones defined in 
Section [1] on the plane. We then study the optimal control problems and find some minimizers properties. 

Section [3] contains the main results of the paper: we prove Propositions [T][2][3] using properties of minimizers 
of problems studied in Section [2l 



2 Solution of optimal control problems 

In this section we recall the definition of the two optimal control problems given above. In the first we consider 
the Dubins' car [8]: it can both move forwards and rotate on itself. In the second we have the Recds-Shcpp car 
|16) . that can move forwards, backwards and rotate on itself. Nevertheless, the problems we study are different 
than the ones studied in [H [16]. We don't have constraints on velocity and curvature. Wc want instead to 
minimize (in both cases) a cost depending both on velocity and curvature. 



2.1 Dubins' car with lenght-curvature cost 

The Dubins' car is a car that can move both forwards and rotate on itself. The dynamics of the car is given 
by the following control system: 

X \ / coa{9) \ / \ 

Ml > 0, (6) 

with ui,U2 e L^([0,T],R). We impose ui > to forbid backwards displacements. Observe that ui is the 
planar velocity of the car and U2 is its angular velocity. The controllability of this system can be checked by 
hand, and we omit the proof. 

We fix a starting point go = (a^o, yo,9o) and an ending point qi ~ (xi, yi, 6*1). We want to minimize the cost 

^ C \lnl+ul (7) 
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over all trajectories of ([6]) steering qo to qi. Here the end time T is fixed. 

Remark 5. This problem is a left-invariant problem on the group of motions of the plane 

( / cos(6l) -sin(6') a; 
SE{2) =n sin(e') cos(6') y ] \ {x,y) e 6 e R/27r 
IV 1 

where the group operation is the standard matrix operation. Indeed, in this case the dynamics is given by 
g = ui gpi + U2 gp2 with 

Pi = 

If the constraint ui > is removed, we have a minimal length problem on the sub-Riemannian manifold 
{SE{2), A, g) where A is the left-invariant distribution generated by pi,p2 at the identity and g is the metric 
on A defined in g by the condition gg {gPi, gpj) = Sij. For details about sub-Riemannian geometry on Lie 
groups see e.g. [3]. For a complete study of this sub-Riemannian problem on SE{2) see [12[ I17j . 

As a consequence, the problem of minimization of '^if from qo to qi is equivalent to the same problem from 
Id to q^^qi- For this reason, from now on we will study only problems starting from Id. 

2.1.1 Existence of minimizers and reduction to controls 

In this Section we apply Filippov existence theorem to the optimal control problem ©-(O on SE{2), that 
provides the existence of minimum. We then prove that it is equivalent to solve this problem with controls 
Ui € or with controls Ui £ L°°. This result permits to verify that minimizers found via the PMP, that works 
in the framework of L°° controls, are minimizers also in the larger class of controls. 

We first transform problem ([5])- ([7]) in a minimum time problem. It is a standard procedure to transform 
the problem ©-([T]) with fixed final time T to a problem in which the dynamics is given again by (|6]), the cost 
is the time (that is free) and the constraint on the controls are ui > 0, + U2 < 1. 

We apply Filippov existence theorem for minimum time problems, see e.g. [1] Cor 10.2], that gives a 
minimizer, hence optimal controls. 

We now prove that we can restrict to L°° optimal controls. This generalization cannot be proved in general. 
Indeed, Lavrcnticv phenomenon can occur for more general dynamics and costs, i.e. it may exists a trajectory 
with controls such that its cost is strictly less that the cost of all trajectories with L°° controls, in particular 
solutions of PMP. For details see e.g. |11) . 

We thus restrict ourselves to minimal length problems on a trivializable sub-Riemannian manifold with 
constraints on values of controls. 

Lemma 1. Consider a minimal length problem on a trivializable sub-Riemannian manifold (7\if, A, g) with 
constraints on values on control, i.e. 



Ill, pT / "1 

q = V u,F,{q) u{t) e F C M" [<?(.)] = / J V ^ min (8) 

^=l -^0 y 

where A{q) — span {i^i, . . . , Fm\ and gq{Fi(q), Fj(q)) — 6ij. Assume that the set V satisfies 

aV = {av \ V eV} <ZV for all a e R+ U {0}. 

// there exists a minimizer q(t) of this problem with optimal controls Ui £ , then there exist other optimal 
controls Ui £ L°° such that the corresponding trajectory is a minimizer that is a reparametrization of q. 

Proof: Let q: [0,T] — > M be a minimizer of the problem with optimal controls in . Define 



f{t) -.^ jygm,q{T))dr^ j' f2unr)dT 
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that is a function from [0,r] to [0,i], with L = ^^[l]- The function / is absolutely continuous and non 
decreasing, hence the set R of its regular values is of full measure in [0, L\. We also define g : [0, L] [0, T] by 

g{s) :=inf{te[0,T]|/(0-s}. 

One can easily check that Vs S [0,i] it holds f{g{s)) = s. 

Moreover, if g is discontinuous at sq then /~^(so) is a closed interval of the form [to,ii] and Vt G [<o,ii], 
one has /^^ V g ^l^)) rfT = 0, hence = g(io) = Q{g{so))- This also proves that g o g is continuous. 

We also have that g o t; is a 1-Lipschtzian function (hence absolutely continuous) since 



raisi) . ^ ; 

<9(5(so)),g(5(si))) < / Vg(9(T),g(r))dT = |.so-si|, 

"'9(so) 



where .) is the sub-Ricmannian distance d((7oi 1\) '■— inf ['?(•)] I satisfies ([8]) and steers go to gi}. 

For s G R, q is diffcrentiable at s and its derivative is q(s) ~ tt^ttt- We also have that g is differentiable 
' » ' ^ f{g{s)) 

at g{s) because s is a regular value of /, which implies that g is defined. Hence one can easily compute 

g (^(t), g(r)) = 1. Moreover, for s e i? we have 

hence g o g is an admissible curve corresponding to controls 



that are L°° controls. 

Once these L°° controls on [0,L] are found, make a linear reparametrization of the time s i— >■ ^ and a 
corresponding rcscaling of controls ui i— > Ui := We have now a reparametrization of the same trajectory 
g with controls u,; bounded by ^, hence L°°, on the interval [0,T]. □ 

Remark 6. Our problem ©-([T]) satisfies hypotheses of Lemma [1] with V — {(ui, V2) G | vi > O}. 

Remark 7. A consequence of Lemma[T]is that it is equivalent to look for or for L°° optimal controls. Indeed, 
if we have a minimizcr with controls in L^, then we reparametrize them and find a minimizer with controls in 
L°°. On the opposite side, if we have a minimizer q{t) over the set of controls in L°°, it is also a minimizer 
over the set of controls in L^. We prove it by contradiction. Let q{t) be a trajectory with controls in and 
whose cost is less than [q{t)]. Reparametrize q{t) and find a trajectory with controls in with the same 
cost, hence q(t) is not a minimizer. Contradiction. 



2.1.2 Computation of extremals 

We now apply the PMP to the problem ©-(IT]) transformed into a minimum time problem. For the expression 
of PMP for minimum time problems see e.g. [1] Ch. 12]. The control-dependent Hamiltonian of the system is 

i7(g, A,w) = (A,g) = Mi/ii + U2/12 (9) 

where hi = cos{9) + Xy sin(0), h2 ~ Ag, and Aj,, Aj^, Xg arc the components of the covcctor A in the dual basis 
with respect to coordinates (x, y, 9). Notice that H can be seen as the scalar product (ui, U2) ■ {hi, /12) in M^. 

We don't give a complete synthesis of the problem, since we only need to find a particular minimizcr to use 
in proofs of Propositions [l][2] 

We first consider normal extremals, for which we can choose H ~ \. Let us denote a and p an angle and a 
positive number in such a way that A^; — pco&{a) and Xy = psin(Q;). 
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Let us assume that at t = to wc have /ii(to) > 0. Then PMP gives controls ui — hi, U2 ~ after having 
normahzed || (/ii, /i2)|| = 1. Dynamics is given by 



It is the equation of the pendulum with 6 = a being the unstable equilibrium. This implies that when starting 
with \e{ta) - a| < § in R/27rZ, then 9 will reach a value such that \e{to) - a| > f in R/27rZ. Hence the 
corresponding extremal will have a time ti > to for which hiiti) < 0. 

Let us assume now that at t = to we have hi{to) < 0. Then PMP gives controls ui = and U2 = sign(ft,2). 
In this case, the extremal corresponds to a rotation on itself. Indeed, the dynamics is given by 



Since A^; and Xy are constant, either they are both vanishing all along the extremal (that is hi = 0) or there 
exists at least one of them that is nonvanishing. In this case, there exists ti > to such that /ii(ti) > 0. 

As already stated, for an extremal satisfying hi{to) > (resp /ii(to) < 0) there exists a time ti > to such 
that hi{ti) < (resp /ii(ti) > 0). Thus an extremal is the concatenation of trajectories satisfying (jlip. i.e. 
pure rotations, and trajectories satisfying ([TUl) . that arc arcs of pendulum in 9. 

Consider an arc 7([to7^i]) satisfying ([TT|) between two arcs satisfying PH)) . Then the variation of 9 along 
this arc should be of tt because 6'(to) = a + ^ niodTr and we should come back to 9{ti) = a + ^ modTr at the 
end with the dynamics 9 = 1. Moreover, one can prove that a concatenation of dynamics (|10p . ([TT]) and ([TU)) 
cannot be optimal. 

Remark 8. A consequence of this study to the planar problem of minimization of J on is that planar curves 
with cusps are extremal, but never minimizers. Indeed, a curve with cusp is the projection of a curve q{.) 
containing an interval in which i = y = 0, while 9 has a variation of tt. Hence, the non optimality of q implies 
non optimality of the planar curve with cusp. 

We finally consider abnormal extremals, for which we have H = 0. Wc have two possibilities: 

• either hi = h2 = 0, for which the trajectory is a straight line (i.e. ^ = 0); 

• or /i2 = 0, /ii < 0, thus ui = 0, for which the trajectory is a pure rotation (i.e. x = y = 0). 
Abnormal extremals can also be concatenations of these two kind of trajectories. 

2.1.3 An example of a minimizer 

In this section wc give an example of a minimizer q(.) defined on a small interval [0,2^] and satisfying (jlip 
on [0,^] and PT7|) on [^,2^]. This trajectory is the basic example that we will use to prove non-existence of 
minimizers of cost 1^ both on and ^2, i-e. Propositions [T] and [21 

Consider a trajectory q^{t) starting from Id, with given A^i- = — \ = 0, Ag = All quantities related 
to this trajectory are denoted with superscript 1. Since hi(0) < 0, wc follow dynamics given by (|lip on an 
interval [O, t^] and we have 



X = hi cos{9) 
y = hi sin(0) 

\ A^ — Ay = 
9 = h2 

Ae = hi {-Xr, sm{9) + Xy cos{9)) 



(10) 



We have |6'(to) — aj < ^ in R/27rZ and the equation on 9 is: 

29 = sin(2(6i-a)). 




(11) 



x\t') = y\t') = Xl{t' 



Ai(i^) 



1 



xlit' 




V2 



7 



Wc choose = f and observe that hl{t^) = 0. Rccah that on this interval controls are = 0, = 1. 

Then dynamics is given by pH)) on an interval + s^] . Since Ag is continuous, so is. Then 6^{t) = 

f + - t^) + o{t - t^) on + s^) , thus > on (t^,t^ + s^) for a sufhciently small choice of As a 

consequence, ^ 0, 7^ for all i G + s^), eventually choosing a smaller s^. 

Recall now that all normal extremals are local minimizers, i.e. for each extremal q(t) and time to there 
exists e such that q(.) defined on the interval [to — s,to + s] is a minimizer between q{to — e) and q(to + e). For 
details, see e.g. [U Cor 17.1]. We apply this result to q^{t) in t^ and find a corresponding e^. Hence we have 
the minimizer q^{t) over the interval [t^ — Notice that this minimizer is but not in i^. 

We now prove that for a small ^ < the trajectory q^(t) is not only a minimizer, but the unique normal 
minimizer steering Qo = q^{t^ ~ to Qi ~ q{t^ + ^). We prove it by contradiction. Assume that there exists 
another minimizer q^ steering Qo to Qi- In the following all quantities related to this minimizer are denoted 
with superscript 2. As a consequence of the existence of q^ , wc have another minimizer q^{.) steering q^{t^ 
to q^{t^ + given by the concatenation of q^ on [t^ ~ e^,t^ ~ ^] > then q'^ on [t^ — C, + j then again q^ 
on [i^ + £,,t^ + e^] . See Figure [31 Since q'^ is a minimizer, then it is a solution of PMP. As a consequence, its 
tangent covector is continuous. For this reason, we have A^(t^ ^ = X^{t^ — £,). Since this covector satisfies 
hi < 0, then trajectory q^ satisfies dynamics given by pT|) on a neighborhood of t^ — ^, hence q^ and coincide 
on this neighborhood due to uniqueness of solution for ([TT]) . We can prove in the same way that q^ and q'^ 
coincide on the whole interval [t^ — ^, t^). Similarly, we have X^{t^ + = A^(i^ + ^), hence q^ and q^ coincide 
in the whole interval {t^, t^ + £] due to uniqueness of solution for (jTU]). Finally, they coincide also in t^ due to 
continuity. Hence = q^ on the interval [t^ ^ + ■ Contradiction. 




Figure 3: Construction of trajectory q'^. 

We now define the trajectory q in SE{2), using q^ defined on the interval [t^ — ^, + . We first perform 
a left multiplication of q^ in order to have q^{t^) = Id, then a time shift [t^ — £,,t^ + S^'j [0, 2^]. The resulting 
trajectory is q(t) := (q^(t^)) ^ q^{t + — ^). We recall some properties of this trajectory that wc will use in 
the following: 

• q(0 = Id. 

• q is the unique minimizer steering q(0) to q(2^). 

• q satisfies dynamics (|TT|) on [0,^] and (fTO)) on [C,2^]. 

2.2 Projective Reeds-Shepp car with lenght-curvature cost 

The Reeds-Shepp car is a car that can move forwards, backwards and rotate on itself. The set of configurations 
can be identified with a quotient of the group of motions of the plane SE{2)/ ~ where (x, y, 6) ~ (x, y,0 + tt). 
For a better comprehension we use the same notation used for SE{2), omitting the identification. We also omit 
checks of good definitions of dynamics and cost given below. 

The dynamics of the car is given by the following control system: 

/ \ 

(12) 
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where mi,W2 G L^{[0,T],R). 

Fix a starting point qo = {xQ,yQ,6o) and an ending point 51 = {xi,yi,6i). We want to minimize the cost 



/ ^/ul+ul (13) 

over all trajectories of ([T2|) steering (70 to qi. Here the end time T is fixed. 

Also in this case, due to invariance by rototranslation of both the dynamics and the cost, we can study only 
problems starting from Id = (0, 0, 0) = (0, 0, tt) and we will do so all along the paper. 

Controllability is a direct consequence of Rashevsky-Chow theorem (see e.g. [l]) for this problem, since the 
distribution span {(cos(6'), sin(6'), 0) , (0, 0, 1)} is bracket-generating. 

2.2.1 Computation of extremals 

In this section we compute minimizers for the optimal control problem (|12p - (|13p . We follow procedure presented 
in Sections [2XT]|2T2l 

First transform it in a minimal time problem where dynamics is given again by ()12p and controls are 
bounded by + M2 < 1- Following Section [2.1.11 we prove that the problem admits a minimum for all pair 
of starting and ending points and we restrict ourselves to L°° optimal controls. We then apply PMP, using its 
expression for minimal time problem. Since dynamics (jl2p on SE{2)/ ~ coincides locally with dynamics 
on SE{2), we have the same control-depending Hamiltonian 

H{q, X,u) ~ {X,q) = uihi + U2h2 (14) 

where hi = XxC0s{9) + AySin(0), /i2 = Xe, and Xx,Xy,Xe are the components of the covector A in the dual 
basis with respect to coordinates {x,y,9). 

We can neglect abnormal extremals, since in this case they are trajectories reduced to a point. 

We H = 1 and observe that we don't have condition wi > in this case. Hence solutions of the PMP 
are given by the choice ui ^ hi, U2 ^ h2, that correspond to pendulum oscillations presented in Section [2.1.21 
The corresponding dynamical system is the solution of 

X = hi cos{6) 
y = hi sin(0) 

< A, = Ay = (15) 

= h2 

Xe = hi {—Xx sm{9) + Xy cos{9)) . 

The explicit solution of this problem is given in [T7] in the case of SE{2). For our treatment, it is sufficient 
to observe some properties of extremals. First of all, they are completely determined by the initial covector A, 
due to uniqueness of solution of (fT5|) . Moreover, the solution is analytic. As a consequence, we have only one 
of these possibihties: 

• cither hi = 0, and the corresponding extremals are q{t) = (0, 0, d'^{t)), 

• or hi has only a finite number of times ti,...,t„ in which it is vanishing, hence the corresponding 
trajectory q{.) has only a finite number of points in which both x and y are vanishing. 

Notice that trajectories of the second kind can be "well projected" to the plane, i.e. it holds 

Lemma 2. Let qit) — (x{t),y(t),9(t)) be an extremal for the optimal control problem hl'^fjl - H^) for which hi 
is vanishing only for a finite number of times ti, . . . , t„. Let p{t) — Il{q{t)) be the projection of q on the plane 
via n : (x, y, 6) i— > (x, y). Then for each time t S [0, T] we have either pit) w (cos(0(<)), sin(0(<))) or p{tQ) ~ 
and hm,^,- ^ « lim,^,+ ^ « {cos{e{t)),sin{0{t))). 
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Proof: First notice that p ~ {uicos{9),uism{0)) since q satisfies (|T2|) . Hence it is clear that p{t) ss 
(cos(6'(i)),sin(6'(i))) if ui{t) ^ 0. 

If instead ui{t) = 0, then there exists an interval {t — £,t + e) on which Mi(r) ^ for all t ^ t. Thus 
= « (cos(0(r)), sin(0(T))). Passage to limit provides the result in t. □ 

Remark 9. An interesting property (see |17j ) of this second family of extremals is that there are minimizers 
with one or two points in which ui = 0, but trajectory with three or more points in which ui = are never 
minimizers. Thus minimizers for J over the set ii?3 may present one or two cusps, but not more than two. 

We will use in the following these properties to prove existence of a minimizer of J over all curves in ^3. 
Notice that Lemma [2] doesn't hold for minimizers of the problem on SE(2) defined in Section [^31 since there 
are minimizers (like q) such that their projection satisfies p = on an interval and p 7^ on another interval. 

3 Solution of problems and existence of minimizers 

This section contains the main results of the paper. We first prove Propositions [T] and [21 i.e. the non-existence 
of minimizers for the problem of minimization of J respectively in ^1 and ^2- On the contrary, we prove 
Proposition [3l that is the existence of minimizer for the problem of minimization of J in i^3. 

3.1 Boundary conditions with orientation: non-existence of minimizers 

In this section we give a counterexample to the existence of minimizers of J for boundary conditions with 
orientation. We prove it both in the case in which curves are chosen to be in ^1 and in ^2- The basic tools we 
use are the lift of a planar curve to SE{2), see Remark 21 and the trajectory q(i) on SE{2) defined in Section 
I2.1.3[ that is a solution of the optimal control problem (Hj)-© studied in Section [^TTl 

The basic idea is that we can lift the planar problem to the problem on SE{2), then solve the problem 
on SE{2) and finally project it again on the plane. But this last step doesn't work well, since in the case we 
present below the projection of the solution of the problem on SE{2) doesn't satisfy boundary conditions with 
orientation fixed at the beginning. 

Start considering the trajectory q(<) = (x(<:), y(t), 0(t)) on SE(2) defined in Section [2.1.31 on the interval 
[0,2^]. Define its projection p{t) := n(q(t)) on the plane via the map 11 : {x,y,9) {x,y). As already 
stated, notice that p = on (0,<^) and p ^ on (^,2^). Then define a sequence of planar curves on the 
same interval, satisfying the following conditions: 

• Each of them satisfies the following boundary conditions with orientation: 

p"(0) = p(0), p"(20 = p(20, P"(0) ~ (cos(0(O)),sin(0(O))), ^"(2^) ^ p(2C). 

• The sequence converges to p. 

• The cost J [p"] converges to [q] . 

Since now, notice that, if p" exists, then it is an example of the fact that each p" satisfies some boundary 
conditions with orientation but the limit trajectory p doesn't, since p = on (0, ^) and p(C^) ^ (1, 0). 

We define the curve p" with a geometric construction, see Figure [H First define p" on + I'l coinciding 

with p. Then define the point C := P + |-) and draw the line r that is the tangent to p or p" at C. Then draw 
the line s passing through the origin O = (0, 0) and (cos(6'(0)), sin(6i(0))). Since 6'(^+t) = e{^)+t+o{t) =t+o{t), 
then + I;) > Oj while 0(0) < 0, hence r and s are not parallel, thus they have an intersection point B. 
Then we have two cases: 

• If ^ (OB) < ^ {BC), fix point D on BC such that (OB) = (BD) and define the arc OD that is 
tangent to OB in O and to BC in D. In this case, define p" on (0,£, + |;) as the concatenation of the 
arc OD and the segment DC. 
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Figure 4: Construction of the trajectory p" (case {OB) < ^ (BC)). 



• If instead ^ {OB) > ^ {BC), fix D on OB satisfying ^ {BD) = ^ {BC) and make the construction of 
the arc DC. In this case on (^0,^ + ^ is the concatenation of the segment OD and the arc DC. 

Notice that all p" satisfy boundary conditions with orientations and that the sequence converges to p. 
Moreover, J [p"] restricted to the interval + ^,2^j coincides with J [p] on the same interval, that in turns 
coincide with ^ [q] on the same interval, since q is the lift of p (see Remark 2]). 

Concerning the interval [O, £ + , we have C ^ B ^ O iox n ^ oo, hence J \DC\ or J \OD\ tends to 0. 

Instead the cost of the arc OD or DC tends to — 6'(0). Indeed, assume that ^ {OB) < ^ {BC) and compute 
J [od] with an arclength parametrization. Recall that in this case = a-y{b) — a^(a) where a^(i) is the 

angle of the tangent vector 7, thus 

""oD - "oB(^) = / ^^'7 ds<J [od] < {l + K,)ds=^ {od) + [D) - a^{0). 

The result follows recalling that (Z?) ^ 6* + |) -^9 {£,) = 0. The case if {OB) > ^ {BC) can be 
treated similarly. 

We have thus defined a sequence of curves p" G ^1 C ^2 minimizing the cost J but such that the limit curve 
p does not satisfy boundary conditions with orientation, hence it is not in ^2- We prove that it implies the 
non-existence of a minimizer for these boundary conditions. By contradiction, assume that a minimizcr of J 
exists in ^2- Thus its lift q to SE{2) is a minimizer for between q(0) and q(2£). Since q is the unique normal 
minimizer between the two points, then q is abnormal. Since (x(0),y(0)) 7^ (x(2£), y(2£)) and 9{0) ^ d{2e), 
then q is neither a straight line nor a pure rotation, hence it is a concatenation of straight lines and rotations. 
Its projection is thus a curve with angles, i.e. it is not in ^2- Contradiction. 

3.2 Projective boundary conditions with orientation: existence of minimizers 

In this section we prove existence of a minimizing curve in for all choices of projective boundary conditions, 
i.e. we prove Proposition [3l The basic idea is that also in this case we can lift the problem of planar curves to 
the problem on SE{2) / ~ defined above, solve it and then project the solution to the plane. But in this case 
the whole procedure works well, since the projection of the solution of the problem on SE{2) / ~ is always the 
solution of the planar problem. In particular, it satisfies projective boundary conditions. 

Start fixing projective boundary conditions, i.e. fix a starting point {xq, yo) with direction vq and an ending 
point {xi,yi) with direction vi. Assume that {xo,yo) ^ {xi,yi) and vq, vi are nonvanishing vectors. Recall 
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that we want to find a curve 7 S ^2 such that 7(0) = (xq, yo), 7(0) sa vq, i{T) = (xi, yi), 7(r) sa vi and that 
is a minimizer of J. 

Consider the optimal control defined on SE{2)/ ~ presented in Section with the following starting and 
ending point: qo = {xo,yo,6o) and qi = {xi,yi,9i) where each 0i is the angle formed by the vector Vi with 
respect to the x-axis. Then solve the problem and call q(.) the minimizing trajectory (that is not necessary 
unique). The basic remark is that q is of the second kind (see Section [2.2.ip . since {xq, yo) ^ {xi,yi). As proved 
in Lemma [21 in this case p « (cos(0), sin(0)) except for a discrete set of points ti, . . . ,tn on which we have 
the weaker property limT-_j.(; (cos(0), sin(0)). If we have at the starting point p(0) 7^ 0, then p satisfies 

projective boundary conditions at the beginning. Otherwise reparametrize p by arclength in an interval [0,e], 
that is possible since is the unique point in the interval in which p = 0. As a consequence, now p satisfies 
boundary conditions at the beginning, since wc have p(0) ~ lim^_j.o ~ (cos(6'(0)), sin(6'(0))). The same 
result can be proved for the ending point. Hence p satisfies projective boundary conditions. 

We now prove that p is a minimizer of J, by contradiction. Assume that there exists p satisfying the 
same projective boundary conditions and such that J [p] < J [p\- Thus its lift q steers qo to qi and satisfies 
[g] < [q], hence q is not a minimizer. Contradiction. 
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